
#include "planner_pkg/planner_util.hpp"
#include "cmath"

namespace planner_util
{

    double pointDistance(int x1, int y1, int x2, int y2)
    {
        return std::hypot(x1 - x2, y1 - y2); // 欧几里得距离
    }

   
    
}